clear
% townName = 'town03/';
townName = '../output/';
driving_center_line_file = [townName,'driving_center_line.txt'];
position_file = [townName,'position.txt'];
driving_lane_file = [townName,'driving_lane.txt'];
geometry_offset_file = [townName,'geometry1.txt'];
geometry_file = [townName,'geometry.txt'];
restrictedLine_file = [townName,'restrictedLine.txt'];
path_file = [townName,'pathForPlot.txt'];
% drving center line
temp=load(driving_center_line_file);
driving_center_line = [temp(:,1) temp(:,2)];
% driving lane
temp=load(driving_lane_file);
driving_lane = [temp(:,1) temp(:,2)];
% geometry offset
temp=load(geometry_offset_file);
geometry_offset = [temp(:,1) temp(:,2)];
% geometry
temp=load(geometry_file);
geometry = [temp(:,1) temp(:,2)];
% path
temp=load(path_file);
path = [temp(:,1) temp(:,2)];
% position
temp=load(position_file);
position = [temp(:,1) temp(:,2)];
% % restricted lane
% temp=load(restrictedLine_file);
% restrictedLine = [temp(:,1) temp(:,2)];

% 绘制
hold on;
axis equal;
% plot(restrictedLine(:,1),restrictedLine(:,2),'Square');
% plot(driving_center_line(:,1),driving_center_line(:,2),'.g');
plot(geometry_offset(:,1),geometry_offset(:,2),'.k');
plot(driving_lane(:,1),driving_lane(:,2),'.k');
% plot(geometry(:,1),geometry(:,2),'.r');
plot(path(:,1),path(:,2),'.c');
plot(position(:,1),position(:,2),'sr');
% plot(baseframe(:,1), baseframe(:,2),".");